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Abstract 

The paper considers a motion control problem for kinematic models of nonholonomic wheeled 
systems. The class of maneuverable wheeled systems is defined consisting of systems that can 
follow any sufficiently smooth non-stop trajectory on the plane. A sufficient condition for ma- 
neuverability is obtained. The design of control law that stabilizes motion along the desired 
trajectory on the plane is performed in two steps. On the first step the trajectory on the con- 
figuration manifold of the system and the input function are constructed that ensure the exact 
reproduction of the desired trajectory on the plane. The second step is the stabilization of the 
constructed trajectory on the configuration manifold of the system. For this purpose a recursive 
procedure is used that is a version of backstepping algorithm meant for non-stationary systems 
nonlinearly depending on input. The procedure results in the continuous memoryless feedback 
that stabilizes the trajectory on the configuration manifold of the system. As an example the 
motion control problem for a truck with multiple trailers is considered. It is shown that the 
proposed control law stabilizes the desired trajectory of the vehicle on the plane for all initial 
states of the system from some open dense submanifold of the configuration manifold, i. e., 
almost globally. The statement takes place both for a truck pulling any number of trailers in 
a forward direction and for a truck pushing any number of trailers in a backward direction. 
The latter result is the solution of the intuitively hard problem of the road train reverse motion 
control. The effectiveness of the proposed control is demonstrated by simulation. Animated 
examples are presented at Sergei V. Gusev Web Page. 
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1. Introduction. 



The control of nonholonomic mechanical systems is a subject of intensive study (see survey 
|17j ) that is mainly devoted to the transport robot control. These investigations can be classified 
into two groups: feedforward and feedback control strategies. The first direction, known as 
the motion planning problem, is presented in the comprehensive monograph JHl- The second 
direction can be subdivided into problems of the equilibrium manifold stabilization [31^, the 
zero state stabilization [2111111112211211121112215 and the stabilization of desired trajectory. Despite 
that latter problem is of great practical importance it is less investigated then other stabilization 
problems. 

One approach to stabilization of the desired trajectory uses approximate linearization of 
the system in the neighborhood of this trajectory [HjSnj. Unfortunately, thus obtained linear 
feedback is guaranteed to perform well only in a small neighborhood of the desired trajectory. 

Another approach is based on the system transformation to the chained form [27]. In ^H] 
such a transformation is used for the trajectory stabilization of wheeled systems. Though the 
constructed feedback is not globally stabilizing its domain of attraction is not necessary a small 
neighborhood of the desired trajectory as in the previous case. However, this approach has a 
drawback that some trajectories, despite of being traceable in principle, are nevertheless missed 
in the domain of the transformation and hence they could not be stabilized. Thus the approach 
imposes unnecessary and unnatural restrictions on the desired trajectories of the system. For 
example, whether or not a particular trajectory is stabilizable might depend on the choice of a 
Cartesian coordinate system on the plane. 

This paper deals with a specific variant of a trajectory tracking problem for wheeled systems. 
We select a point fixed in the body of the vehicle and are trying to define the vehicle control 
that stabilizes the motion of this distinguished point along a given trajectory on the plane. 
Note that when given a planar desired trajectory, we are not presented with the corresponding 
high-dimensional trajectory on the configuration manifold of the system. Therefore, we find the 
control in two steps: 1) the motion planning step during which we construct an input function 
and the corresponding trajectory on the configuration manifold of the system, so that the latter 
maps exactly onto the planar desired trajectory; 2) the stabilization step, wherein we stabilize 
the constructed trajectory. 

The purpose of this paper is the design of the control law that stabilizes any non-stop motion 
of the distinguished point of the vehicle along any sufficiently smooth curve on the plane. To 
this end it is supposed that the system can trace any such a trajectory on the plane. Systems 
that have this property are called maneuverable. 

We give a sufficient condition for maneuverability of wheeled systems. For systems that 
satisfy this condition the motion planning problem is solved, i.e., the algorithm is proposed that 
using the desired trajectory of the distinguished point constructs the corresponding trajectory 
on the configuration manifold of the system. 

The stabilization of the constructed trajectory is based on a nonlinear state feedback trans- 
formation of the kinematic model of the system to a simplified cascaded form. The recursive 
application of a backstepping-like procedure to the cascaded system gives a continuous memo- 
ryless feedback that stabilizes the trajectory. 

In our previous papers it was shown that a polar state transformation can be used to achieve 
the local stabilization of the desired trajectory in the case of caterpillar ^10| and four-wheeled [20] 



2 



mobile robots. Such a transformation allows to obtain the high performance practical control 
algorithm for trajectory tracking of the mobile platform [7j. 

This paper extends previous results using a more general state feedback transformation of 
the system. The constructed control law stabilizes the motion of a truck with multiple trailers 
along any non-stop trajectory that has a sufficient number of bounded derivatives. We tackle 
the task both for a truck pulling any number of trailers in a forward direction and even for a 
truck pushing any number of trailers in a backward direction. In addition, the stabilization is 
almost global in sense that the attraction domain of the trajectory is an open dense submanifold 
of the system configuration manifold. 

For the Chaplygin sled^, which is the simplest wheeled system, the constructed feedback 
is memoryless, continuous on the whole configuration manifold and guarantees the global sta- 
bilization of the desired trajectory. The latter example shows that the assumption about the 
non-stop character of the motion is essential. Because, a well known Brockett's result implies 
that a continuous memoryless feedback cannot globally stabilize the desired configuration of the 
Chaplygin sled. 

The simulation shows the effectiveness of the proposed method of trajectory tracking control. 
The animated simulation is presented in P|. Preliminary results on the maneuverable vehicles 
control can be found in [12]. 

Finally, we should note that while the present paper deals with kinematic models of wheeled 
systems, the obtained results can serve as the basis for the stabilization of dynamical mod- 
els of vehicles (by analogy with results in where the stabilization of the dynamical model 
of a car is considered) as well as for the adaptive control of robots using methods in [Hj 111! 11^1 114j. 

2. Mathematical model of the system. 

Wheeled vehicles are nonholonomic mechanical systems. We begin by describing the math- 
ematical model of such systems. The configuration manifold of the system Q is the real smooth 
manifold with local coordinates q = (gi, . . . , q^)- Let TgQ and T*Q denote tangent and cotan- 
gent spaces of the manifold Q at a point q, and let TQ = UgeQ ^qQ T*Q = Uges T*Q denote 
tangent and cotangent bundles of this manifold^. The kinematics of a nonholonomic system is 
described by a set of one-forms Ui G T*Q, i = 1,. . . ,n, that define the linear homogeneous 
nonholonomic constraints 

= 0, j = l,...,n, (1) 

where {uj{q),q) denote the action of the linear functional uj{q) G T*Q on the tangent vector 
q G TgQ. The trajectory of a nonholonomic system is the function q G C^([0, oo),Q) that 
satisfies the equations (jT)). Hereinafter C''{Aii, Ai2), k = 0,1,2,..., denotes the class of k 
times continuously differentiable maps of the manifold Aii into the manifold 7^2- 

Let JC be an open submanifold of Q such that the codistribution Q = span{a;i, . . . ,0;^} C 
T*Q is constant-dimensional on JC. The codistribution Q defines on /C the [m = N — n)- 
dimensional distribution A = VL^ = {g E TK, \ {00, g) = Va; G fl}. We assume that smooth 

^The Chaplygin sled is the wheeled system that has one wheel and two sleeve bearings The free movement 
of this system was first investigated by Chaplygin in . This system is also called knife edge ■ 

^Hereinafter we use conventional but somewhat inaccurate notations that identify the point of manifold and 
its coordinates. Comments on such shorthands can be found in |25j . 
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vectorfields gi, . . . ,gm form a basis of the distributfon A. Then any lying in /C trajectory of the 
nonholonomic system satisfies the differential equation 



m 



(2) 



i=l 



where u = col('Ui, . . . ,Um) G C([0, oo), R"^). Equation is referred to as a kinematic model 
of the nonholonomic mechanical system. The freedom in defining the kinematic model is in 
the choice of the submanifold K. and the basis vectorfields gi, ■ ■ ■ ,gm- We consider Q as the 
equation that describes a control system with input u. 

The wheeled system is a set of interconnected rigid bodies with wheels that can move on the 
plane. The wheels are constrained to roll without slipping. The position of the system on the 
plane is defined by the Cartesian coordinates xi,X2 of a distinguished point, which is selected 
belonging to one of the wheel axles. Let yi be heading angle of the corresponding wheel, then 
the rolling without slipping constraint for this wheel takes the form 



We take a natural assumption that the constraint equations are invariant with respect to 
translations of the Xi, X2 plane. 

It is typical for a vehicular system to have two scalar inputs. In terms of nonholonomic 
constraints it means that the number of constraints is two less then the number of degrees of 
freedom of the system. 

Our assumptions can be summed up as follows: 

I. Q = X Q, where Q is a smooth manifold of dimension n. The vector of coordinates 
of the system can be represented as g = co\{x,y), where x = col(a;i,a;2) is the vector of 
Cartesian coordinates of the distinguished point, and y = col(?/i, . . . ?/„) are the remaining 
coordinates. 

II. The kinematics of the system is described by the set of nonholonomic constraints (Q) that 
includes the constraint Q. 

III. The one-forms uJi,i = 1, . . . ,n, do not depend on the coordinates xi, X2- 

Let /C be an open submanifold of Q. It turns out that under very non-restrictive assumptions 
the wheeled system admits on JC the kinematic model of the following special type 



where Ui and U2 are inputs, Ui is the longitudinal velocity of the distinguished point motion 
along the vector {xi,X2) ^ R^, that has slope yi, hi, h2 G TQ. The output of the system is the 
distinguished point position x = col(xi,X2). Therefore the output trajectory of the system (jlj), 

will be referred to as the distinguished point trajectory. 

The control system (jl}, © is the subject of investigation in this paper. 



Xi sin yi — ±2 cos y\ = 0. 



(3) 



Xi = Ml cos 1/1, 

X2 = Misinyi, 

y = uihi{y) +U2h2{y), 



(4) 



(5) 
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Figure 1: Kinematic scheme of an automobile (I). 

Proposition 1: Suppose the manifold K, has the following properties: 
Kl. JC = X y, where y is an open suhmanifold of Q. 

K2. The dimension of the codistribution Q = span {ui, . . . , Un} is constant on K,. 

K3. For any Qq E IC there exist the trajectory of the system q G C"'^([— 1, 1] K.), passing 
through the point (q{0) = q^), and such that x{0) ^ 0. 

Then the wheeled system admits the kinematic model ^ on the manifold JC. 
The proof of Proposition 1 is given in Appendix A. 

As an example consider the kinematic model of an automobile, the scheme of that is shown 
in Fig. m The vector of coordinates is g = col(xi, X2, yi, 1/2), where xi and X2 are the Cartesian 
coordinates of the midpoint of the rear axle, yi is the heading angle, and ?/2 is the angle between 
the front and rear axles. Define the configuration manifold as Q = x S^, where 5*^ is the 
unit circle. From here on we shall employ the usual angular coordinate on the and we shall 
define trigonometric functions on S^, where the argument will be the angle thus defined. 

Nonholonomic constraints take the form j2Sl 

xi sin yi - X2 cos yx = 0, 

xi sin(?/i + 1/2) - X2 cos(?/i + 7/2) - yi cos 1/2 = 0, 

where for simplicity the length of the automobile base (the segment AB) is assumed to be 
unity. The constraints © are defined by the one-forms uji{q) = sin?/i(ixi — cosyidx2, oj2{q) = 
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sin(|/i + y2)dxi — cos(yi + y2)dx2 — cosy2dyi. It is easy to see that K. = {q E Q \ cos?/2 7^ 0} 
is the maximal submanifold of the manifold Q, where the codistribution Q = span {cji, ^^2} is 
constant-dimensional. The defined on JC kinematic model of an automobile has the known form 

Xi = Ui cosyi, 
X2=Misin?/i, 

iji = Mitan?/2, ^ 

2/2 = U2, 

where Ui is the longitudinal velocity of the point A and U2 is the angular velocity of the front 
axle spin relative to the automobile body. 

Let us split the manifold K, as JC = x y, where 

y = {y= {yi,y2) eRxS'\ cos 1/2 ^ 0}. (8) 

Then the equation ((Tj) takes the form (jH), (0) with hi{y) = col(tany25 0), h2{y) = col(0, 1). 

3. Maneuverable systems. 

Let us consider the planar trajectory x° G C([0, oo), i?^) as the desired trajectory of the 
distinguished point of the system (jH), ©■ 

Definition 1: The trajectory x° is called admissible trajectory of the distinguished point of the 
system ^, ^ if x° e C"+i([0, cx)), i^^) and 

inf > 0. (9) 

The set of all admissible trajectories of the distinguished point of the system (jH), © is denoted 

X C C"+n[0,oo),i?2). 

Definition 2: The system Q), (0j is called maneuverable on an open submanifold Ai G JC, 
if for any admissible trajectory of the distinguished point of the system there are the trajectory 
q° = col(x°,y°) G C\[0,oo),M) and the input G C{\Q,oo),R^) that satisfy 0, 1$. The 
operator M : X — » C^([0, oo), 7W) x C([0, cx)), i?^), which takes x° to the pair {q°,u°), is called 
the maneuvering operator of the system. When Ai = JC, the system is called maneuverable 
(without specifying the manifold). 

A wheeled system is not necessary maneuverable. We shall demonstrate this with an example 
at the end of the section. The theorem below gives a sufficient condition for the wheeled 
system maneuverability. The proof of the theorem constructively defines the set of maneuvering 
operators for the system. 

Let us introduce some notation. Consider a vector field h and a function defined on a 
manifold 3^. Denote = (d0, h) = I]i=i ^^''^^ ^^e Lie derivative of the function along 
the vector field h. The repeated Lie derivatives Ll^(f),i = 0, 1,2, ... , are inductively defined by 
= and Lj^cj) = LkL^^^cj), z > 1. In what follows we suppose that all manifolds, vectorfields, 
and functions are smooth enough to define all necessary Lie derivatives. 
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Theorem 1 : Let O G y be an open submanifold that is split as O = R x O. Suppose that for 
all y G O the following conditions hold 

Lh,Lly, = 0, i = 0,...,n-2, (10) 

L,,Ll;'y, ^ 0. (11) 

Then the smooth change of coordinates 

s = S{y), (12) 
where the map S G C^{0,R"') is defined by the equation 

S{y) = co\{Lly,...,Ll;'y), (13) 
and the nonsingular feedback transformation 

V = F{y)u, (14) 
where the map F G C{0 ,GL{2)) is defined by the equation 



F{y) 



1, 

Ll^ct>{y), L,,Ll;'<p{y) 



(15) 



transforms the system ^ into the system 



Xi = Vi COSSi, 

X2 = Vi sinsi, 

Si = fiSi+i, i = 1, . . . ,n - 1, 



(16) 
(17) 



If S bijectively maps O on i?", then the system (0j is maneuverable on the manifold Ai = 
X O. 

Remark 1: Under the transformations Mi^) and the equations Si = yi,Vi = Ui hold, and, 
consequently, the x-subsystem ^ does not change. 

Proof. The representation (fTH|) . (fT7j) can be obtained using the weU known transformation 
of a nonlinear system to the canonical linear one [T3]. However it is not difficult to prove this 
statement directly. Suppose that y is the solution of the system (0) that corresponds to the 
input u, and that s and v are defined by the transformations (fT^ and ()14|) respectively. Then 
from (UnD, (US), and (HHD we obtain 

s^it) = ui{t)Li^yi{t) +U2{t)Lh^L\-^yi{t) = vi{t)si+i{t), i = l,...,n-l, 
i„(t) = Ui{t)Lly,{t) + U2{t)L,,,Ll;'y,{t) = v^it). 

It is easy to see that, conversely, for any solution of ()17|) there corresponds some solution of (0), 
which is defined by the reverse transformation of variables. 
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Using (Uni), define the longitudinal velocity of the distinguished point that moves along the 
desired trajectory x° 

= ±^{xut)r + {xmr, (is) 

where the sign of can be chosen arbitrary but does not vary in time. Calculating si{t) by 
virtue of (fT^ with vi{t) = v^{t), we get 

• m _ ^2 Wcossi -i?(t)sinsi 

Note that Q implies the inequality inft>o |ff ()f:)| > 0. The desired heading angle s°(t), t > 0, 
can be found as the solution of the differential equation (fT^ with the initial value s°(0) that 
satisfies the equation 

' coss°(0) 



Define s°{t) using the recursive formulae 

sf{t)=st^it)/vfit), z = 2,...,n, (21) 

and put 

v^it) = s^it). (22) 

Then the triplet x°,s°,v° satisfies the system of differential equations (fTBj) . (fTTj) . Since the 
transformation S is diffeomorphism O onto i?", we can define the trajectory 

y-{t) = S-\s-m (23) 

which satisfies the inclusion y°{t) G O for all t > 0. The desired input u° can be uniquely 
defined from the equation 

u^it) = F~\y-it))v^it), (24) 

because the matrix F{y) is nonsingular in O. The triplet x^,y°,u° satisfies (@]), (0). ■ 

The proof gives the procedure for determining the maneuvering operators for the system Q, 
(0). After choosing the sign of in (fTHj) and the initial value s°(0) satisfying ()20|) . the formulae 
(jl8|) - (j24p uniquely define the pair q° = co\{x° , y°) , for a given admissible trajectory x°. 

As an example of Theorem ^ application let us show that the kinematic model of an automo- 
bile ((Tj) is maneuverable. The manifold y defined by (jH)) is disconnected and consists of two con- 
nected components. It is easy to see that the conditions (fTUI) and (fTT|) of Theorem^ are fulfilled 
on each component. For definiteness choose one component O = {(y 1,^/2) ^ I I1/2I < 7r/2}. 
On O the formulae (fT!?jl and (fTH|) define the state transformation S{y) = col (yi, tan 2/2) and 
the feedback transformation vi = ui, V2 = M2Cos~^?/2. The system (0) is maneuverable on the 
manifold O x R"^ because S bijectively maps O onto R^. 

In this example the choice of sign in (jlSj) defines the trajectory g° and the input u° 
that correspond to an automobile forward motion along the desired trajectory x°, whereas the 
sign "-" in (jl8p corresponds to an automobile backward motion along the same trajectory x°. 

Our next example shows that not any wheeled system is maneuverable and, more over, 
the maneuverability of the system depends on the choice of coordinates. Let us define the 
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Figure 2: Kinematic scheme of an automobile (II). 



coordinates of automobile as follows: Xi,X2 are the Cartesian coordinates of the distinguished 
point B, which is the midpoint of the front axle, yi is the heading angle of the front wheels, 1/2 is 
the angle between the front and rear axles (see Fig.|2)). The configuration manifold of the system 
is Q = X and can be split as Q = R'^ xy, where 3^ = RxS^. The kinematic model is defined 
on the whole manifold Q and takes the form (jH), (jSJ with hi{y) = col(sin 2/2, 0), h2{y) = col(l, 1). 
It is easy to see that conditions of Theorem ^ are not fulfilled for this system. 

In fact, this system is not maneuverable. To show this let us construct the trajectory x° 
that cannot be traced by the system. From Fig. |21 it is clear that at each instant of time t the 
curvature of the point B trajectory is equal to l/p(t), where p(t) is the length of the hypotenuse 
of triangle ABC. Hence, p{t) > 1 for all t > 0. It follows that the system cannot trace any 
trajectory x° the curvature of which is less than one at some instant of time t > 0. Thus the 
considered system is not maneuverable. 

4. Formulation of the trajectory stabilization problem. 

Let x° be a desired trajectory of the distinguished point of the system. The problem under 
consideration is to stabilize the motion of the distinguished point with coordinates x along 
the desired trajectory But it is important also to guarantee boundedness of the control 
input of the system. Otherwise the stabilization has no practical application. For the input 
to be bounded, it does not suffice to assume the admissibility of the trajectory; more strict 
requirements have to be satisfied. 
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Definition 3: The trajectory x° of the distinguished point of the system (0j is called 
strongly admissible if it is admissible and, in addition, all its derivatives up to the order n + 1 
are bounded, i. e., supj>Q maxfc=i^...^„+i |(i'^/(it'^a;°(t)| < +00. 

The set of strongly admissible trajectories of the distinguished point of the system (jlj), (jSj) 
is denoted X. 

For maneuverable systems the problem under consideration can be refined. Let the system 
(13)), (0) be maneuverable on the manifold Ai = x O. Then for any admissible trajectory on 
the plane the maneuvering operator M defines the trajectory q° = col(x°,?/°) of the system 
dH), (0) and the input u° such that the trajectory lies in M. and corresponds to the input u°. 
In this case becomes possible to replace stabilization of the desired planar trajectory x° with 
that of the trajectory q°. Clearly, the solution of the latter, more general problem, implies the 
solution for the problem of tracking the trajectory 

Suppose that c? is a metric on the manifold O. Consider a map $ G C{Ai x M. x U,R^), 
where U = {u e R"^ \ ui ^ 0}. 

Definition 4: The feedback 

u = ^q,q^it),u^it)), (25) 

where q = col{x,y), q° = col{x°,y°), stabilizes the trajectory q° in A4, if for any initial value 
g(0) G Ai the solution of the closed-loop system / T^) is defined and lies in M. for all 

t > 0, and if the following limits hold: 

^lim(x(t) -x°(t)) = 0, (26) 
lim%(t),y°(t))=0, (27) 
lim(u(t) -M°(t)) = 0. (28) 

t — >oo 

This definition implies, in particular, that if the input function v° is bounded, so will be the 
input u of the closed-loop system. 

Now we return to the problem of the desired trajectory x° stabilization. Consider an operator 
U : [0,+oo) X M X X ^ U, which for t G [0, +00), q G M, and x° G X is defined as the 
superposition 

f/(t,g,x°) = <l>(g,g°(t),n°(t)), (29) 

where 

(g°,M°) = M(x°). (30) 



Definition 5: We say that the control law 

u = U{t,q,x'') (31) 

where the operator U is defined by ^EW> (123^; solves the problem of stabilizing the distinguished 
point trajectories of the system (0) on the manifold M., if for any strongly admissible 
trajectory x^ the feedback stabilizes the trajectory q° defined by / T^) . 
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The prime objective of the paper is solving the trajectories stabihzation problem for the 
wheeled system (0}, © on the manifold where the system is maneuverable. To do this it is 
necessary to design two operators M and $. The former is already defined by Theorem^ The 
latter is constructed in Section 5. 

An additional objective is to make as wide as possible the domain where the constructed 
control law solves the trajectories stabilization problem. From the practical standpoint it is 
desirable to design the control law that solves this problem on the whole configuration manifold 
of the system Q, i.e., globally. Such a control law for the Chaplygin sled is described below, in 
Section 6. The general problem of global stabilization of trajectories is not solved in the paper. 
However, we believe our result closely approximates the goal of the global stabilization. Let us 
explain in what sense. 

Suppose that /C = UI^i where M.i, i = 1, . . . ,m, are disjoint open connected components 
of /C, and for every i = 1, . . . , m, an operator Ui : [0, +oo) x Aii x X — > W is defined. Consider 
an operator U : [0, +oo) x K. x X ^ U defined for t G [0, +oo), g G /C, x° G X by the equation 

U{t, q, x°) = Ui{t, q, if g G Mi. (32) 



Definition 6: We say that the control law with the operator / lo/ijj) solves the problem of 
almost global stabilization of the distinguished point trajectories of the system if the 

manifold K, is dense in the configuration manifold Q, and if for every i = 1, . . . ,m, the control 
law / t,Vi)) with U = Ui, solves the problem of stabilizing the distinguished point trajectories of the 
system ^ on the manifold J^i. 

In the sense of this definition we shall show that the proposed below control law solves the 
problem of almost global stabilization of the distinguished point trajectories for the considered 
in Section 6 kinematic model of a truck with multiple trailers. 

5. Stabilization of trajectories. 

Suppose that the system (jlj), satisfies the conditions of Theorem [T] on the manifold A4 
and that M is a corresponding maneuvering operator. Let x° be an admissible trajectory of 
the distinguished point. Using the operator M, define the trajectory g° = col(x°,?/°) and the 
input u° {{q°,u^) = M[x°)). After the state feedback transformation ()12|). ()14|) the system 
(jU, (0) takes on the cascaded form (fT^ . (fTTj) and our design of the stabilizing feedback is 
based on that form. Using the state transformation ()12j) define the trajectory s°(t) = S{y°(t)), 
s° G C^([0, +oo), i?"). To apply the backstepping technics we shall represent the system (fTHj) . 
()17p in terms of deviations from the trajectory s°). 

5.1. Further transformation of the kinematic model. Consider the function r(t) = 
/q ^ (ii + {x2{'^)ydK] the value r(t) is the length of the path traveled by the distinguished 
point in a time t. Due to the equality f(t) = and the inequality ©, the function r(.) 

maps the interval [0, oo) bijectively onto itself. The inverse function is denoted t{.). 

Define functions x(r) = x°(t(r)), s(r) = s°(t(r)), T;(r) = t;°(t(r)), x(r) = a:(t(r)) - a;°(t(r)), 
and s(r) = s(t(r)) — s°(t(r)). The change of variables from t, x, s to r, x, s transforms the system 
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(Uni), (EI) into 



x' 



COS Si 

sin si 



s' 



WiSi+i + [Wi 
W2, 



+ wiG{si) 
wi)si+i, i = 1, 



cos Si 
sin §1 

. . ,n - 



(33) 
(34) 



where 



G(si 



cos Si — sm si 
sin si cos si 



wiir) = vMr))/\viir)\, «^2(r) = {v^itir)) - v^ir)) /\v^{r)\. 



(35) 



Note that Wi = fi/|fi| = sign t>i does not depend on r. Hereafter the prime denotes the 
differentiation with respect to r. The above transformation uses the following formulae: Vi{t) = 
<(t(r)), 



G(si: 



X 



COS Si 




sin si 




= WiCOSSi, 



cos(si + SiJ 
sin(si + si) 



wi sm si, 

V2/\vi\. 



n — 1, 



(36) 
(37) 



5.2. Cascaded system stabilization theorem. To design a stabilizing feedback for the 

system (jSHl), use a recursive procedure based on the idea of backstepping JTHI. Let us 
formulate one step of the procedure. 
Consider the cascaded system 

z' = B{z,C,p{r)), (38) 

C = b{z,C,p{r))+P{z,C,p{r))v, (39) 

WW . . BSC .R,r Cn|0,oo).fi^.), B,- e an- X U x . 

C{R''^ xRx R^^.R), p{zX,p{r)) ^ for all z,C,r. 

Suppose functions a e C^{R^'' x R^\R) and V e C^{R^'' x R^p x R^%R) are given that 
satisfy the conditions 

Vr a(0,r) = 0, (40) 

Vp,r 1/(0, p,r) = 0, (41) 

V z 7^ 0,p,r V{z,p,r) > 0, (42) 

y£>0,£ >0 inf V{z, p, r) > 0. (43) 

2:|>e, max(|p|,|r|)<£' 
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Define a function a : 7?*^^+^ x B}'^ x R^^^ x i?^'' ^ _R by 



9r 



^ i^Ki^l-ElllL)(2;,(,a(z,r),p) - 6(z,C,p) - 7(C - "(2;, r)) 



where 



(44) 



B{z,C,p) - B{z,r],p) 

C-v 

dB{z,C,p) 
dC ' 



if C = ^, 



and a function : x x i?^"- — > i? by 

y (5, p, r) = V{z, p, r) + 6{( - a{z, r)f/2. (45) 

Here 7 > 0, 5 > are parameters, z G R''% C,r] e R, z = col(z, (), p G -R*"", r, ri G -R''^ 

Theorem 2: The function a is continuous, the function V is differentiahle and satisfies the 
conditions ^^-^Bjj, where z should he replaced with z. 

• If the derivative of the function y(2;(r),p(r), r(r)) along the trajectories of the closed-loop 
system / T^) . 

C = a(z,r(r)) (46) 

satisfies the inequality 



V'{z{r),p{r),r{T)) < -2^V{z{r),p{r),r{T)), 



(47) 



then the derivative of the function V"(z(r),p(r), r(r)) along the trajectories of the closed- 
loop system / T^) . / T^) . 

t; = d(i,p(r),r(r),r'(r)) (48) 

satisfies the inequality 



V'{z{r),p{T),r{r)) < -27V(i(r),p(r), r(r)). 



(49) 



If the functions p^r are hounded and the inequality \49^ holds on the solutions of the system 
UB^) . K^) . ( 17^ , then this system is glohally asymptotically stahle. 



If 

then 



WpeR''^ B{0,0,p) = and 6(0,0, p) = 0, 



yp e R''", r,ri e R^'' d(0,p, r, ri) = 0. 
//, in addition to listed assumptions, the function r' is hounded, then 

lim a(z(r),p(T),r(T),r'(T)) = 

holds on the solutions of the closed-loop system ^^) . ^^) . JT^ . 



(50) 
(51) 

(52) 
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Proof. The continuity of the function a follows from ()44|) and properties of functions 
a,B,b,P, and V. It should be noted that the function is defined and continuous for all 
z G R''^, C ^ -R; t > because /3 is continuous and non- vanishing and that the function 
D{z, C, a{z, r), r) is defined and continuous for all z G -R'^^ ( E R, r E R^'' due to the continuity 

dB 

of the functions B and . 

Let us show that V satisfies the conditions (jlT|) - The equality pT|l is obvious. 

Consider the inequality (jl^ . Let z = co\{z,() 7^ 0. We have V{z,p,r) > for 2; 7^ 0, 
since V{z,p,r) > V{z,p,r). If z = then V{z,p,r) = 5(C — a(0, r))^/2, and, by virtue of (HO}, 
V{z,p,r) = > for C 7^ 0. The inequality is proved. 

We show (H3|) by reductio ad absurdum. Suppose this inequality is not fulfilled. Then there 
are e > 0, > 0, and sequences {rn}T=i^ {PkI^^d (I^^I > k^l < b^l < = 

1,2,.. .) such that 

lim V(4,pK,r«;) = 0. (53) 



Let Zk = co1(2;k, Ck)- Then by virtue of 

lim V"(2;«,p«,r«) = 0. (54) 

The limit and the inequality PHj) imply 

lim Zf^ = 0. (55) 

From the continuity of the function a and the limit ()55|) it follows that 

lim a(2;K,r«;) = 0. (56) 

The substitution of and in gives lim Ck = and, consequently, lim z^ = 0. The 
latter contradicts the assumption made about the sequence This contradiction proves 

that the function V satisfies fliH|) . 

The derivative of the function V along the trajectories of the closed-loop system (|HHj). (|^. 
()48|) has the form 

T>//^ N dV{z,p,r) dV{z,p,r) , dV{z,p,r) , 
V (z, p, r) = — B{z, C, p) + p + r + 

6{C-a{z,r)MzX,p) + f3{zX,p)v-^^^B{zX,p)-^^^ 

jdV{z,p,r) dV{z,p,r) , dV{z,p,r) ,1 

= ^^^B{z,a{z,r),p) + -^^P + | + 

{^^^^BizX,p)-'-^^^ 

SiC-aiz,rmz,C,p)+P{zX,p)v - ^^^B{zX.p) - . 

The expression in the first curly braces is the derivative of V along the trajectories of the system 
flHH|) . (Uni)- By virtue of (jH}, the term in the second curly braces is equal to — 75(C — a{z,r)Y. 
Thus, taking into account (HZj), we obtain 
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The inequality ()49|) implies that the limit 



lim V(i(r),p(r),r(r)) = 



(57) 



takes place on the solutions of the system (j38|) . (j39|l . (j48|) . 

Let us show that if max(|p(r)|, |r(r)|) < E for some E and all r > 0, then the system (jHHl), 
fKffl|l . (jlH|) is globally asymptotically stable. If this is not the case, then there are e > 0, a 
solution z of the system (jHHj) . (jHIIj) . PHj) . and a sequence {r^}^!, — >k^oo cxd such that 



inf 

K = l,2,. 



> e. 



(58) 



By virtue of (jl^ . we have inf|2|>£^ max(|p|,|r|)<£' r) > 0, therefore it follows from (jSHjl that 
y(i(r«,),p(r^), r(r«)) y^^^^^ 0. This contradicts (jSZI)- Thus the system dHHl), dSHl), (EHI) is globally 
asymptotically stable. 

The equality (jKT|) follows from (03}. This implication is based on the equalities (j^DI), ()4()j] 

9V(0,p,r) 



and on the identity 



dz 



0, which follows from the fact that for any p and r the function 



V{z,p,r) achieves minimum when z = 0. 

The limit ()52|) results from the continuity of the function a, the boundedness of the functions 
r and r', and from the equality (|5ip. ■ 

5.3. Stabilization of s-subsystem. Consider the stabilization problem for the x-subsystem^ 
of the system (jH^ . (jH^ . The feedback, that solves this problem, is used to initiate the 
recursive process of designing the stabilizing control law for the system (jHHj) . (jS^)- 

The inputs of the system are Wi and Si. Denote E{wi, Si) the right-hand side of 
It is evident that the equation 

E{wi,si) = e (59) 

is solvable for any vector e G i?^. Taking into account that on the solutions of the closed- loop 
system 5i has to tend to zero, we look for a solution of that satisfies the inequality 



< n/2. 



Let us rewrite as 



where 



Wi 



G{siy\e + wi 



cos Si 
sin si 

cos Si 
sin si 



(60) 



(61) 



G{si) e + wi 



1 




cos Si sm si 
— sin si cos si 

■^It should be noted that the x-subsystem (|33ll is not a transformation of the kinematic model of the Chaplygin 
sled, which is third order system and is considered in Section 6. 
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For nonzero c, the equation has a solution satisfying the inequahty (IHUj) only if ci 7^ 0. 
This condition can be guaranteed if the vector e satisfies the inequality |e| < 1 since in this case 
sign ci = wi. Define 

e = J^^^(j\^\h. (62) 



Consider the Lyapunov function candidate 

Vo{x) = sinh2(7|i|). (63) 

Calculating the derivative of Vq along the trajectories of the system and assuming that 
right-hand side of is equal to e, by virtue of (jH^ we obtain 

^ ^^ sinh(7|x|)^cosh(7|x|) ^.^^^ ^ ^^^^ 
Thus, to guarantee the stability of the closed-loop system it is sufficient to put 

Si = arctan(c2/ci) ao{x,Si,Wi), 



where 



tanh(7|a;|) 



-G{si) ^x + wi 
\x\ 

In such a way, we arrive at 



1 




Proposition 2: The closed-loop system / 1 6'^) is globally asymptotically stable and has the 

Lyapunov function / fF3)) satisfying the inequality |^^ . 



5.4. Recursive design of stabilizing feedback. Using the feedback ()65|) . transform the 
system (|33p , (j34j) to the form that is convenient for the recursive application of the backstepping 
procedure. Let Wi = X{x,Si,Wi), where A is defined by Define functions p^ : R ^ 

i = 0, . . . ,n, as follows: p° = col(cos Si, sin Si), p\t) = col(cossi, sin Si, S2, . . . , Sj+i), i = 
n—1, p'^{t) = col(cos si, sin si, S2, ■ ■ ■ , s„, V2/V1). Then the system flS^ . (jH^ can be written 



i+2 



. . . , 

as 



where 



5' 



Eo(x,Si,/(r),«;i), 

6i(x,p*(r),iDi) + /3i(x,p*(r), wi)si+i, z 



(66) 
(67) 



5o(x, si,p°(r), wi) = -wi 



cos Si 
sin si 



+ A(x, si, wi)G'(si 



cos Si 
sin Si 



hi{x,p'{T),Wi) = (A(X, Si,Wi) - Wi)Si+i, Pi{x,p\T),Wi) = A(X, Si,Wi), 

i = 1, . . . ,n — 1, 

Sn+l = W2, bn = 0, /5„ = 1. 
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The design of the stabihzing feedback is performed by the recursive use of the backstepping 
procedure to subsystems of the system (jHSl), ^7\i . wherein we successively increase the number 
of equations in subsystems. 

It is convenient to represent the ith subsystem in the form 

{z'-'y = B,^^{z'-\5„p\T),w,), (68) 
s[ = k{z'~\p'iT),w,) + /3,iz'-\p\T),wi)s,+,, (69) 

where = col(a;, si, . . . , Sj), i = 0, . . . , n, is the state vector of the ith subsystem, 

5„p^(r), W7i) = col(5o(;20, 5i,/(r), ^i) + 

/3i(zO,pH^),w^i)S2,...,&i-i(^*-',P*-'(r),t/;i)+A„i(2^-2^p^"i(r),^i)5i). 

Since Wi is constant, it is considered clS db parameter. 

Let us describe the ith step of the recursion. Suppose that on the previous step functions 
J9*~^, Wi) and Vi_i(z*~^,p*~^, Wi) were constructed such that the derivative of the func- 
tion Vi_i along the trajectories of the closed-loop system (jUSj) . 

Si = ai_i{z'~\p'~\T),wi) 

satisfies the inequality 

VU^'-\t),p^-\t),w,) < -27F,_i(/-i(r),p-i(r),u;i). 

On the first step we use the defined in Subsection 5.3 functions ao and Vq that satisfy the above 
assumption. 

Choose an arbitrary Si > and define functions aj„i, Vi_i according to (jH}, (jl^j) with 
a = V = Vi_i, z = z'-^, z = z\ r = p''^, ri = (p*~^)', p = p\ B = Bi_i, b = k, /3 = 

Pi, 6 = 6i. Note that using the equations (jHU)) . ^7\i we can represent the functions and 
j^pi-iy terms of the function as follows: 

p'-'=co\{p\,...,pU)^^P,{p'), 

= col(— s'l sin Si, s[ cossi, S2, . . . , s-_^i) = 
co\{-pIpIwi,p\pIwi,pIwi, . . . ,pIwi) = P-{p\wi). 

Define functions 

ai{z\p\wi) = ai_i{z\p\Pi{p'),P^{p\wi),Wi), 
Vi{z\p\wi) = Vi^i{z\p\Pi{p\wi),Wi). 

By virtue of Theorem|21 the functions a^, Vi have the same properties as the functions ai-i, Vi-i. 
Consequently, the recursion can be continued. 

On the nth step of the recursion, the function is defined such that the system (jUU]) . (jU7j) . 
W2 = an{z'" ,P^{t),wi) is globally asymptotically stable. 

Turning to the system (IHHj). (1211), define the following feedback function 



^(x, s, s, v) 



X{x,si,wi) 
a„(2;",p",tyi) 



(70) 



where = col(cos si, sinsi, S2, . . . ,Sn, V2/V1), z"- = col(x,s), wi = sign vi. The result obtained 
can be formulated as 
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Proposition 3: Let the functions Si, i = 2, . . . ,n, be bounded, then the closed-loop system 

a, 

w = \l/(a;, s, s, v), (71) 
where \1/ is defined by f7^ , is globally asymptotically stable and 

lim W7(r) = col(wi,0). (72) 

r^oo 

Proof. To prove the proposition it is sufficient to show that the conditions of Theorem |21 
are fuffilled on each step of the recursion. 

Let us begin from the smoothness of the considered functions. The functions ^^^^^^jlj^a; and 

Vq(x) = sinh^(7|x|) are infinitely differentiable for all x G R^, the matrices G{si),G{si)^^ are 
infinitely differentiable for all Si G R. Therefore for fixed Wi = ±1 the functions X{x,Si,Wi), 
ao{x, si,wi), Bo{x, si,p^, wi), bi{x,p^ ,wi), Pi{x, si, wi) are infinitely differentiable with respect 
to the other arguments. 

Because of the function A definition we have Pi{x,p\wi) = X{x,si,wi) ^ for all x G 
i?^, Wi = ±l,p* G i = 1, . . . ,n. Since 

A(0, si,wi) = wi (73) 

for all Si E R and Wi = ±1, we have from the definition of the functions hi and that the 
equalities bi{0,p\ wi) = and i?i_i(0, 0,p*, wi) = hold for alH = 1, . . . , n, G i?*"*"^, wi = ±1. 
From it follows that the equality ao(0,p°,wi) = is fulfilled for all p° G R^. By virtue of 
(IMll . the function Vq satisfies (ITTIl . 

In such a way, all the conditions of Theorem |21 are fulfilled on the first and all subsequent 
steps during the recursion. This implies that the closed- loop system (jMj) . (fTUj) is globally 
asymptotically stable; and, moreover, ()51|) implies lim W2{t) = 0. The limit lim wi{t) = wi 
follows from (|73p . the asymptotic stability of the closed- loop system and from the uniform con- 
tinuity of A. ■ 

5.5. Main result. To obtain the control law for the system Q, (0), the variables x, s,w,t in 
the control law (fTOj) should be transformed into the initial variables x, y, u, t and the function 
p"(r) should be expressed in terms of the trajectory g°(t(r)) = col(a;°(t(r)), ?/°(t(r))) and of 
the input u°(t(r)). 

The functions x, s, u are defined in such a way that for all r > the equalities 

x(r)=a;°(t(r)), 

-s{r) = S{y-{t{r))), (74) 
vir) = Fiy-itiT)))u-itiT)) 

hold. The input v can be obtained from (jHSj) and the last among the equalities in (fflj) 



vit) = \viirit))HTit)) 







\uUt)\wiTit)) + F2iy^it))u-it), (75) 



where F2 




1 



F. The formulae (f7i|) . (ff3j) . and (fT^ define the desired feedback function 



$(g, g°, u^) = [F{y)]-' {|<|M/(x - x^, S{y) - S{y^), S{y^), F{y^)u^) + F2(y°)n°} , (76) 
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where g, g° G i?""^^, q = co\{x,y), q° = col(x°,?/°), u° G are vectors and not functions of 
time. 

Theorem 3: Suppose that: 

A. The conditions of Theorem Q are fulfilled on the manifold Ai = x O, and M is a 
maneuvering operator. 

B. The metrics d is defined on O = RxO by the equation d{y, y') = \yi —y[ \ +d{y, y'), where 
y = col(?/i,y), y' = co\{y[,y'), yi,y[ G R, y,y' G O, d is a metrics on 6. 

C. The vectorfields hi, h2 do not depend on the coordinate yi. 

Then the control law h2f^ ]- ^Sl\] with the maneuvering operator M and the feedback function $ 
given by \7(^ solves the problem of stabilizing the distinguished point trajectories of the system 
(0j on the manifold M.. In addition, on the trajectories of the closed-loop system the input 
u is bounded. 

Remark 2: From JT^ it follows that for all t > sign Ui(t) = sign u°(t) and, consequently, 
sign ui{t) does not vary in time. 

Remark 3 : The statement of Theorem d holds without assumptions B and C if the first com- 
ponent y° of the trajectory y° is bounded. However, this assumption seems to be too restrictive, 
because it excludes trajectories such as the circle motion. 

Proof. Let x° be a strongly admissible trajectory of the distinguished point. Using the 
maneuvering operator M, define the trajectory g° = col(x°, y^) and the input u° that correspond 
to x° {{q°,u°) = M{x°)). The change of variables from x,y,u,t to x,s,w,t transforms the 
system (jlj), © into the system (jSHI), (jSl|) and it transforms the feedback fOK|l into the feedback 



and (f7^ hold on the solutions of the closed-loop system (f7T|) . The reversed change 

of variables in the formulae (f77j) . (f7H|) . (f?^ gives the limits (pUj) . 



By Proposition El the limits 



lim s(r) = 0, 



lim x{t) = 0, 



(77) 
(78) 




maps S : O ^ R"' ^ and F : — > GL{2), such that for all y = col(?/i, . . . , ?/„) G O, we have 



S{y) = co\{yi,S{y)) 



(81) 



F{y) = F{y) 



(82) 
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where y = col(?/2, ...,yn)- 

Since S is bijective, the map S" is a bijection O onto Let us prove that S is diffeomor- 

phism. It can be shown [TS] that the conditions ()10|1 . |TT| imply the relations 

|det Jac Siy)\ = \iU,Ll;'y,)r ^ 0. (83) 

It follows from (j8T| and (j83|) that for all y G C we have det Jac S{y) = det Jac S{y) 7^ 0. Thus 
S" is a diffeomorphism (^28j, Chapter 3, Theorem 29). 

Consider the trajectory s° = S{y°). The formulae (fTn|) . PT|) and the fact that the trajectory 
x° is strongly admissible imply the boundedness of the functions sf, i = 2,...,n. Denote 
s° = col(s2 , . . . , s°), and let 1) C (9 be a compact set such that s°(t) G int V. Since the map 
is uniformly continuous on V, the limit 

lim(%(t))-%-(t)))=0 

t — >oo 

implies the limit 

\imdiyit),rit)) = 0. (84) 

The limit fl27j] follows from condition B of the theorem, from the limits ()79j] . ()84j] . and the 
equalities yi = si, y^ = 

To prove (|^H)) let us show first the boundedness of the input function u°. From the assumption 
that x° is strongly admissible and from the formulae p8|) - (f^^ it follows that f ° is bounded. 
By virtue of (fT^ and (jH^ . we have u° = {F{S~^{s^)))^^v^ . The latter equation implies the 
boundedness of u° taking into account the inclusion s°(r) G T> and the boundedness of the 
continuous map {F o 5*"^)"^ on the compact set T>. 

Let us rewrite (IHUj) as follows: 

hmt^oo {F{y{t))u{t) - F(y°(t))n°(t)) = 

hm.^oo {[F(^-i(s(t)))M(t) -F(S-i(s(t)))iz°(t)]+ (85) 
[F(5"Hs(t)))^°(t) - F(5-Hs-(t)))n°(t)]} = 0. 

Considering that the map F o S^^ is continuous on D and that the input u° is bounded, (|7n|l 
implies 

lim [F(^-i(s(t)))M°(t) - F(^-i(s°(t)))M°(t)] = 0. (86) 

t — >oo 

The limit 

\im{FiS-\rsit))Mt)-u-{t)]} = (87) 

follows from ()85|) and ()86|) . Inasmuch as s(t) G P for all sufficiently large t and the map Fo 
is bounded on "D, (jSTjl implies the limit (f28|l . 

The boundedness of the input u follows from the boundedness of u° and from ()28|1 . ■ 

6. Trajectory stabilization for a truck with multiple trailers. 

Consider a wheeled system that consists of a truck and several half-trailers; the kinematic 
scheme is shown in Fig. |3] Possible collisions of different parts of the vehicle are ignored. 
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The configuration manifold of the system is Q = i?'^ x S*""^ and the vector of coordinates is 
q = col(xi, X2, 1/1, . . . yVn), where xi,X2 are the Cartesian coordinates of the distinguished point 
of the system, which is taken to be the midpoint of the axle of the first half-trailer (trailers are 
enumerated starting from the tail-end), yi is the heading angle of this half-trailer, i/i is the angle 
between the axles of ith and {i — l)th half-trailers, i = 2 . . . ,n — 2, Un-i is the angle between 
the axle of the last half-trailer and the rear axle of the truck, Un is the angle between the axles 
of the truck. The kinematic model of the system has the following form 

Xi = MiCOSyi, 

X2 = Misinyi, .gg. 

i/i = Ml?7i(l/2, . . . « = 1, . . . ,n - 1, 

where 771(^2) =/r^ tan ?/2, Viiy2, ■ ■ . , = (C^ tany,+i - /ri^siny^) 111=2 sec?/fc, i = 2, . . . ,n-l. 
Ml is the longitudinal velocity of the first half-trailer, U2 is the angular velocity of the 
truck forward axle spin with respect to the body of the truck. The equations (jHH|) are de- 
rived in Appendix B. The system (jHHj) is a special case of the system (H)), (0) with hi = 
co\{rii, r]n-i, 0), h2 = col(0, . . . , 0, 1). 
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The system fISHj) is defined on the manifold /C = {g G Q | cos?/j 7^ 0, i = 2, . . . ,n}. The 
kinematic model ()88p is not defined when any two neighbor axles are orthogonal. When n > 1 the 
manifold JC is disconnected, being the union /C = U^gc components with the multi- 

index /i = (/ii, . . . ,/in-i) taking on the values among the corners C of the (n — l)-dimensional 
cube, C = {/i G -R"~^ I yUj = or 1, z = 1, . . . , — 1}. Each A^/_j, yU G C, is connected and has 
the form = {q ^ Q \ l^i-iT^ — 7r/2 < ?/j < /ii_i7r + 7r/2, z = 2, . . . , ra}. It should be noted 
that for yU 7^ the submanifold AA.^ includes exotic configurations with a neighbor half-trailers 
having the opposite orientation. The manifold M.^ can be represented as = x O^, where 

= {y & R X S"""^ I /ii-ivr — 7i/2 < yi < fii-iii + 7r/2, i = 2, . . . ,n}. The metrics on the 
manifold O^, /x G C, is defined as d{y',y") = J2i=i Wi " u'll- 

Proposition 4: The system hS^) satisfies the conditions of Theorem d on each manifold 
The proof of Proposition 4 is given in Appendix C. 

A corollary to Proposition 4 is the maneuverability of the system ()88|1 . It means that the 
midpoint of the tail-end axle of the vehicle that has n — 2 trailers can trace any non-stop 
trajectory x° G C""*"^([0, 00), i?^) on the plane. This is a characteristic property of the smooth 
plane curves. It can be considered as a mechanical description of the smoothness of a planar 
curve. 

According to Theorem 1, on each submanifold A^^, /i G C, the system (jHHjl has a set of 
maneuvering operators. Let us denote by the maneuvering operator, which results from 
choosing sign "-|-" in (fTK|) and choosing the value s°(0) such that the inequality — vr < s^^O) < n 
in equation (f^UI) holds. Similarly, by M~ we denote the maneuvering operator, which results 
from "-" in ^ and the value s^{0) satisfying < s^{0) < 27r. Then the operator defines 
the trajectory for a forward motion of the tail-end trailer along the desired trajectory x°, 
and M~ defines the trajectory g° for a backward motion of the tail-end trailer along the same 
trajectory x°. 

For each fi & C define the feedback function $^ on the manifold A4f^ using the formula 
(f7B|) . Now for any fi & C we construct the feedback operators and U~ using the equations 
(|29|l . dnni) with $ = M = M+ and M = M" respectively. According to Theorem 3, the 
control laws and U~ solve the problem of stabilizing the distinguished point trajectories of 
the system (jHHjl on the manifold A^^, /i G C. 

Finally, we can design the feedback operators and U~ on the manifold /C = U^gc -^m' 
using the formula (jH^ and the operators , , fi E C. Since the configuration manifold Q is 
the closure of /C, both control laws and U~ solve the problem of almost global stabilization 
of the distinguished point trajectories for the considered vehicle. 

It follows from Remark 2 that for all t > the operator defines the positive input 
ui(t) > 0, and U~ defines the negative input ui(t) < 0. Thus, the control law ensures a 
forward motion of the tail-end trailer and U~ ensures a backward motion of the tail-end trailer. 
The latter control law solves intuitively harder problem of stabilizing the road train reverse 
motion along the desired trajectory. 

Notice that the input Ui in the system (|88|) is the longitudinal velocity of the tail-end trailer. 
In practice, the speed of the vehicle is controlled by the speed of the rear-axle assembly of the 
truck. Denote this alternative input ui. It is straightforward to show that the values ui and ui 
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Trailers Truck 




Figure 4: U-turn of the truck pushing two trailers in a backward direction. 

satisfy the equation ui = ui YikZl secy^- Using this equation it is possible to express the control 
law in terms of inputs Ui and U2- 

Consider special cases of the system (jSH|) . 

For n = 2 the equations (j88p coincide with the equations of automobile ((7j) that were con- 
sidered in Section 2. The proposed control law solves the problem of almost global stabilization 
of an automobile motion along any non-stop trajectory that has three bounded derivatives. 

For n = 1 the system ()88|) takes the form 

Xi = MiCOSyi, 

X2 = Misinyi, (89) 
yi = U2. 

and describes the kinematics of the Chaplygin sled |24. Equations (fH^jl are also used as the 
kinematic model of caterpillar vehicles, the lunar vehicle Lunohod, the experimental robot Hi- 
lare described in jHOI- The kinematic model (jH^ is defined on the whole configuration manifold 
of the system Q = R^. Consequently, the proposed control law globally stabihzes strongly ad- 
missible trajectories of the Chaplygin sled. 

7. Simulation. 

For = 1, 2, 3, 4 the rectilinear motion and the circular motion of the system (jHHj) with the 
constructed control law was simulated. The results of simulation demonstrate the efficiency of 
proposed control law. As an illustration Fig. |^ shows the sequence of vehicle positions for an 
U-turn of the truck pushing two trailers in a backward direction. The desired trajectory corre- 
sponds to the motion along the dotted straight line. Animated results of this and some other 
experiments can be found in [H]. 

Appendix A. Proof of Proposition 1. 

By virtue of Kl the system admits on the manifold /C the kinematic model 0, and due to 
condition III for any q = co\{x, y) & K. the vectorfields gi, i = 1,2, depend only on y-coordinates, 
i.e., gi{q) = gi{y),i = 1,2. Let q = co\{x,y) G /C. Condition K2 implies the equalities TqiJC) = 

X Ty{y) and g[{y) = col(//(y), /i^y)), ^ = 1,2, where fi{y) e R\ h[{y) G Ty{y). From the 
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nonholonomic constraint © it follows that //(y) = \i{y)f{y),i = 1,2, where = 1,2, are 
some functions defined on y, f{y) = col(cos?/i, sinyi). 
Consider the feedback transformation 



(90) 



Condition K3 implies that XKy) + ^liv) 0; i-^-, the transformation (jnn|) is nonsingular for all 
y E y. The transformation ()90|) brings the system Q to the following form: 











Ml 


. ^2 . 




A2, — Ai 




. "2 _ 



X = uif{y), 

y = uihi{y) + U2h2iy), 



(91) 



where hi{y) = \i{y)h\{y) + X2{y)h'^{y) , h2{y) = X2iy)h\{y) - \i{y)h'^{y). Equations ^ differs 
from (jD), (0) only by notation of inputs. 

Appendix B. Derivation of the kinematic model for the truck with 
multiple trailers. 

Let us introduce auxiliary variables: Xi = (Xi ? xl) is the vector of the Cartesian coordinates 
of the zth axle midpoint, ipi = J2k=i Uk is the heading angle of the ith. pair of wheels, Xj = 
(cos^/'j, sin?/^j) is the unit vector, that defines the orientation of the ith pair of wheels, Vi = 
(— sin tpi, cosipi) is the unit vector, that defines the orientation of the ith axle, i = 1, . . . ,n (see 

Fig. ED . 

The nonslipping conditions for the wheels define the nonholonomic constraints 



{Xi,^z) = 0, i = l,...,n. 
In addition, the coordinates of the system satisfy the holonomic constraints 

Xi+i = Xi + hTi, i = 1, . . . , n - 1, 



(92) 



(93) 



that describe the articulated joints of half-trailers. Here U is the length of the zth half-trailer. 
Differentiating (jHSl), we obtain the equations 



Xi+i = Xi + ki^ii^i, i = 1, . . . , n - 1, 

that can be used to exclude the derivatives of the dependent coordinates x\ ^ = 2 
the equations (|^. Thus, we deduce the equations of the nonholonomic constraints 

i-l 

— sin ipiXi + cos ilJiX2 + X! h cos{ipj — 'ipi)ipj = 0, i = 1, . . . ,n, 



(94) 



from 



(95) 



where x^ = col(xi, X2) = x. The sum in the left-hand side of is absent when i = 1. 

Let us show that the nonholonomic system described by the constraints (j95j) admits the 
kinematic model of the form (jlj), (0). Scalar multiplication of by z/j and Tj+i gives the 
equations 



ipi = Vil^ tan(V'i+i - V^j), i = 1, . . . , n 



(96) 
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Vi+i = Vi sec{ipi+i -ipi), i = 1, . . . , n - 1, (97) 

where Vi = {ipi, ti) is the velocity of the ith. half-trailer. Subject to the condition cos(^/'i+i — ^/'j) 7^ 
0, i = 1, . . . ,n — l, the equations (|^. yield the known equations of the truck with multiple 
trailers kinematics j2S] 

±1 = t;iCOS'?/'i, 

X2 = t;isin'?/'i, 

ipi = Vili^ tan{^lj2 - i^i), (98) 

ipi = t^i/r^ tan(^/'i+i - ?/>») nfc=2sec(?/'fc - V'fc-i), « = 2, . . . ,n - 1, 

where vi is the velocity of the tail-end half-trailer, Vn is the angular velocity of the truck front 
axle spin with respect of the truck body. The conversion from the variables ip to the variables 
y in gives 



Appendix C. Proof of Proposition 3. 

For fixed fi E C denote Si : O^^ ^ R,i = 1, . . . ,n, the zth component of the map S, defined 
by p3|) . From the definition of the repeated Lie derivative it follows that for i > 2 

s^{y) = Li-'yi = EUvAy^, ■ ■ • '%+i)^^^TV = T.vAy2, ■ ■ • (99) 

Let us show that 

^ = (100) 

for 2 = 1, . . . , n, j = i + 1, . . . , n. To this end the equations 

dSiiy) " d , ^dS.Ay) ^ , ^ d dSi^Ay) . ^ , , 



dyj t^idyj dy^ dy^ dy 



are used that follow from (jHH). For i = 1 Si{y) = yi, and ()100|) evidently holds. Suppose 

__ dSi(y) 
that (llOOl) is fulfilled for i — 1, then the equation (11011) implies — ^ — = for i < j < n. The 

equalities (|100|) are proved. From (|100|) it follows that Si{y) does not depend on n and for i > 2 

^.(l/) = E^.(l/2,...,l/,+i)%i^. (102) 

j=i ^yj 

The straightforward calculation gives 

dSAy) d d d d 

— = ^ ^VK{y2, ■ ■ ■ ,yK+i)^Si^i{y) + ^r]^{y2, . . . ,yn+i)^^Si^i{y) = 
dyi dy^ ^1 oy^dyi ^ggN 

d d 
— r/i_i(?/2, • • -,2/0^ Si^i{y) = /il\ai_i(?/2, • • ■,yi-i) cos'^iyi)- Si-i{y), 

oyi oyi-i oyi-1 
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where cxi = 1, ai{y2, ■ ■ ■ ,yi) = Y{\=2 ^^c{yk), i 

d S (y^ 

From and the equahty 



dyi 



2 . . . , n. 

1 it follows that for i > 1 



- ai{y2,...,yi) [[ [Ij aj{y2 



dyi 



The equations 



and (fTMj) give for z > 2 

Si{y) = Oi{y2, . . . , Vi-i) tan{yi) + ^y2, 



,yi-i), 



(104) 



(105) 



where 



,?/i_l) = (Ti_l(?/2, • • • , 

,y^-i) = -li\ai-i{y'. 



From the definition of Si we have Lh^Ll^^yi 



Vi-iflTjJi lj^(Tj{y2,...,yj) 



yi-i) tan(2/,_i) + E}=i Vjiy2 



9y, 



dyn 



This equality and the equations ()100|) and 



(Uni imply that ^ and (HD) are fulfilled for all y e Of,. 

Let us show that S maps bijectively (9^ onto i?". Choose arbitrary s* G -R" and consider the 
equation 

s* = Siy). (106) 
Define the vector y* G Of, by the recursive formulae 



y* = arctan( ''~^|"^;;;fy^ ) + /i^.iTr, z = 2, 



,77,. 



From (jlOSp it is evidently follows that y* is a unique solution of p06j) . 
We proved that the system (jHHj) satisfies the conditions of Theorem ^ 
Consider condition B of Theorem El Manifold Of, can be represented as Of, = Rx Of,, where 



O.. 



G 5" I fiiTT — 7r/2 < iji < /ijTT + 7r/2, i = 1, . . . , n — 1}. On the manifold Of, define 



the metrics d{y', y") = Y.7=i Wi ~ ^i'l' then the metrics d satisfies condition B of the theorem. 
Condition C of the theorem evidently satisfied by the definition of the vectorfields hi and /i2- 
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